Optimal Path Planning of Redundant Cooperative Robots under Equality and Inequality Constraints

Using kinematic resolution, the optimal path planning for two redundant cooperative manipulators carrying a solid object on a desired trajectory is studied. The optimization problem is first solved with no constraint. Consequently, the nonlinear inequality constraints, which model obstacles, are added to the problem. The formulation has been derived using Pontryagin Minimum Principle and results in a Two Point Boundary Value Problem (TPBVP). The problem is solved for a cooperative manipulator system consisting of two 3-DOF serial robots jointly carrying an object and the results are compared with those obtained from a search algorithm. Defining the obstacles in workspace as functions of joint space coordinates, the inequality constrained optimization problem is solved for the cooperative manipulators.